%% 找到一条轨迹上的t点的下一个点t_1
function [v_before]=next_position1(t,DATA,HEX)
time=unique(DATA(:,6)); %time为不重复的时间序列
k=1;
id=find(strcmp(HEX(1:t-1,1),HEX(t,1))==1);  %找到t点前面的所有轨迹点
if length(id)==0 %前面没点
    v_before=DATA(t,4);
else %前面有点
    for j=length(id):-1:1 %遍历前面的所有点
        if DATA(id(j),4)~=0 %速度~=0
            v(k)=DATA(id(j),4);
            k=k+1;
        end
        if k-1>=6 %收集够六个非零的点
            break;
        end
    end
    if k-1==0 %，没有非零的点
        v_before=10000; %v_before置为一个极大的异常值
    else
        v=v(1:k-1); 
        v_before=mean(v); %t6个非零点的v平均值
    end
end




    